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Nonlinear Control Design Approach for SSF/MRMS 

• Modeling: Attitude Pointing Dynamics of Multi-Flex-Body Systems. 

Hamilton's Principle 

. Attitude Control Decoupling/Linearizing Control by Nonlinear Feedback: 

Partial Feedback Linearization 

. Adaptive Control: Modified Model Reference Adaptive Control (MR AC): 
EnhancCDecoupling and PFL Robustness 

. CSI: Keel flexure and MR MS motion results in nonlinear inertial couplings which effect 
attitude control on short time scale 


. i f ccc u/ii-h MRMS motion and considers nonlinear 
This study addresses attitude control of the S Mah et a , Aut0 matica 1989 and 

dynamic instabilities not previously consi er these previous works concentrated 

and MRMS motion. The study addressed the following points. 

Nonlinear inertia coupling due to keel flexure seriously constrains the stabilisation of 
S5F attitude via linear control methods. 

model uncertainty. 

3 MRAC based on nonlinear design model with exolicit parameW dedehdehce can be 
' effective for stabilization of SSF attitude with uncertain keel stiffness. 

work reported here in modeling and control design builds on previous wo.k reported in: 


1. Baillieul & Levi (1987) Physica D 

2. Bennett, Kwatny, & Dwyer (1988) AFOSR Technical Report TSI-TR-88-07 
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Lagrangian Dynamics for Mixed LPS/DPS 

1. identify configuration space (generalized coordinates) 


2 . 


<! € M 

□ choose DPS coordinates to eliminate Q 
Hamilton's principle: motion is natural if: 


7 B Tq\ t 

geometric B.C.'s 


rt-y 


(6L 


Q T fi'l)dt 


0 


System Lagrangian: L(q,q) : M 
3. solve Euler-Lagrange Eqns. 


subject to B.C.’s , 6 = ij u.V\ 


TqM ft obtains A' = {natural B.C.’s}, or 

d_dL L _dL _ 
dt dq T ; c ? 7 2 


L h nera^zeTr a o f ^nZ ed ?‘ S StU A f ° r m ° del COnstruction utilizes quasi-coordinates and 
generalized Lagrange equations often referred to as Poincare equations. The method in- 

udes explicit construction of Finite Element Methods (FEM) for flexure and spatial re- 
GNC Ve construction of Multi-Body systems introduced by Rodriguez and Jain (1991) AIAA 

in h t e prSAr' iSm of , La 5 ran9ian dynamics proceeds by identification of configuration space 
m terms of generalized coordinates and their velocities. Hamilton's principle idenSes the 

then r tl °A aS 1 th ? SO,Uti ° n of a ^national problem. If the coordinates are independent 
fe a norm ^ U agrange e< luations result. If the coordinate variations are constrained 
Fufaev l972) * V } ^ th * d ' Alem bert-Lagrange equations apply (Neimark & 
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Lagrangian Dynamics for Mixed LPS/DPS 

we say v € HP if Nip = So l^i 2 + ' ' ' + > u|2 dz < °° 
v e H p satisfies B.C.’s up to p tk order 

1, Hamilton’s Principle => “weak" (distributional) solutions in H p g 

2. Euler-Lagrange Eqns. => “strong” (pointwise) solutions in H B P 
Finite Dimensional Modeling and FEM Approximations: 

• Approximate weak solutions by discretization of Lagrangian 
and apply Hamilton's Principle 

• We use collocation by splines for FEM approximation 


The extension of the Lagrangjan .P^chto ba^n fS 

E^ment^MethodT. 5 Our" approach utilizes splines for construction of the elements with 
continuity requirements at knots consistent with the variational problem. 



Lagrange’s Equations using Quasi-Velocities 

Given configuration space ,, e M. Consider quasi-velocities p such that 

7 = t ( <l)p = [i'|. i't. .... 

p = L(q)q = E" 1 • 

□ generally net related to valid set of coordinates .t =p unless 


At = V(q),b, 


is an exact differential 

a Hamilton’s principle applied to Lagrangian in 
Poincare equations (Arnold et al 1988) 


quasi-velocities L(q,p) = L(q,q) 


j 0 2 l 

Op 2 


_ t,-t, 0-L 

P V (q)- 


+ Y, p Jlt ux j + ir v + Q tv 


dt^Op J Op 


A J ~ • • ■ [*>j, V> 


Oq 


W/ j = 1. 


commutators: -z rfj(l)r k 

*=1 

c G form right invariant vector field on of Lie group G associated with U 
□ If -Vis Lie group and ,, are independent, then ,j\ are independent of 


equations are related to Boltzman-Hamel equations and Caplygin’s equations in 

nomic svs^emf ^ 6 USe of . quasi-velocities extends Lagrangian framework to nonholo- 

of first order ODF’Tri^ *£V at, °" s t09ether with the Quasi-velocity definition form a system 
st order ODE s describing the equations of motion for the N-body model. 

1. Quasi-velocities are not time derivatives of physically significant coordinates. 

2 ’ m"ttois‘of n K 0 a f ne 0inCare e ° Uati ° nS '* »'» related to the coostroctiee 


The modeling approach has also been applied to much simpler prototype spacecraft 
u e sewing o the SCOLE model in Bennett, Kwatny, LaVigna 1991 ASME. 
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Structure of Poincare’s Equations in Quasi-Velocities 

Kinetic Energy: f(q,p) = i> t M{q)p 

M(q)p + C(q,p)p + Fiq) = & P 


: = 


Potential Energy: V(»j) 

G eneralized Forces in p-frame: 
(often convenient when quasi-v 




t dV(q) 

Hq) ■= v ('/) p 

0q l 


elocities are referenced to body frame) 
O p := V l {q)Q 


of nonlinear control laws which include explicit model parameter dependence. This 
for evalCatmg tradeoffs in gain scheduled vs. adaptive control .mplementations. 
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Convention 

• conventional linearization 
( when 7 = 0 and ,j = 0) 


al Linearization by Taylor Expansion 

Dy Taylor expansion is valid in the neighborhood of 


an 


equilibrium 


assume /> - 0, then equilibrium configuration is: T( 7 ) = Q 
Linear Perturbation Dynami cs: 

q = V(o )p 

M( 0 ) P + C’(CL0)/> -f °f (0 ) = 
Conventional Linear Control Design Methods: ’ 

fixed gam control limited to neighborhood of equilibrium 
• extension to gain scheduled designs is ad hoc 


be r ° r tne ca ” ° f «»»«« ^ 
t e p frame. Then conventional methods for identification of linear models proceed bv 

Taylor expansion. Note that dynamical changes in configuration such as deployment of 

robot arms ' etc - do not £ 

system mode. aC L L Dlidt r mode? **«?>* .' to impose a " VO linear with reference to a nominal 
iSSS "" StrUCt, ° n f °' PPL «<*'< dep.ndonco on 
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Recursive Formulation for Serial Cham of Bodies 

Notation : velocity in body-frame at C 



Recursive Formulation for Serial Chain of Bodies 


Notation _ 

I C g(k) -inertia tensor aDout CG 
m(fc) -mass 

a(k) -location O in fc-frame 
Mcg(k)-spat\a\ inertia about CG 
\fr>( k) -spatial inertia tensor about O 
• Coordinate free recursion (Jain & Rodriguez 1990) 


A'fcg(k) — 

Mo(k) = 


V'(fc) = <P(r CO (k - 1 ))V(k - 1) + H(k)(5{k) 


rhain model: (constructed from convenient choice of coordinates) 

spatial velocity: V := {V rt ( 1) • • ■ V 

joint quasi-velocity: (i := 1/3 4 ( 1 ) •• - 0 (ff)l 

V = <t>H0 


f Ic9 °r 1 

[ 0 ml j 

<f>* (a)Mcg4>( a ) 


/ ... 0 ■ 


' H(l) 

<K2,1) 1 • " 0 

H = 


: 0 


H(K) 

<t>(K, 1) <KK, 2) ••• I . 




Chain Kinetic Energy: K. E. c / iain 


in terms of 
Chain inertia matrix: 


M = *<$*diag{iV/ 0 (l) . - - 
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Model Formulation with Sliding l-DOF Joints with Elastic Bodies 


Sliding Joint: 1 DOF relative motion along path V defined in k — 1-frame 
• V defined by map ■* : — ► |)?3 as image of e G [eg, J 



Model Formulation with Sliding l-DOF Joints 

. relative velocity of point P on path P wrt (1 - l)-frarne F k ~ l : 


1-1 


o>= f 


inertial velocity of P 


„ 1— 1 _ , 1—1 


Vp "(fc-D-h) 


J k ~ 1 (k - i) + — i 
Of. 


.6 single DOF translational quasi-velocity ,J(1) such that spatial velocity has theform: 


V k (k) = o(y k k (r.))V k k (k - i) 


H k (k)i3 k (k) 


with 


H k (k) : = 


°3x 1 

d-f/Of. 


0 K (k) := 
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Dynamic Decoupling & PFL for Multi-Flex-Body Systems 


Coordinate partitioning: 


Quasi-velocities: 


body attitude 


body rates 


r - control torques applied to main body 
M u Iti-Flex-Body Model: Poincare equations: 

£ = r(£)-- 

u = UA,u)v 

M^-uj + Nv + Fu: = G'jjt 

iX* Jj 4- \fyi' -f F v = G v t 

— PFL (decoupling) Control Law: r *4{£. -u . u. t ) -b L ) a 

such that in closed loop « is commanded attitude accelerations 

i = a 

Fact: exact system attitude PFL using torques referenced to the principal body frame; i.e., 

Gw = /.Gr- = 0 

.4 = Fui - NM^7 1 Fi- + {NM^ 1 B t - A/U r 

B = (A/u> - iVA/J’ 1 iV f ]l 1 


numerical stability of inverse transformation for PFL. 
large angle motions of multi-body articulation. 

Construction of the inertia matrix using quasi-velocities 

together with the assumption of small deformations n the local ^ "^l js ? elated to 

form inertia matrix to be inverted for PFL. e sim simulation of multi-body 

the efficiency of the order-n recursions f currently m use fo ppL CQntrol laws . 
dynamics. Note the construction works for implementation 
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Design Considerations for PFL Attitude Control for SSF/MRMS 

Performance Objectives: 

. Achieve Decoupling of Independent Axis Attitude for Slewing/Pointing Control 

• Achieve Decoupling of Flexible Interactions From Primary System Attitude Pointing 

• Decouple sensitivity to MRMS motions 

D ^ C t ° I 0 ' 6 deS ' 9n of active structural control (smart structures) from principal body 
attitude control 

Practical Limitations 

• Requires Additional Control Authority to Achieve Nonlinear Compensation 

• Compensation Based on Nominal Design Model 
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SSF/MRMS System Configuration 




The simplified SSF/MRMS model includes four ar ^^ a ^f n ^ s di i eS D oF S |Lie S e ' 1 and* 2 ^re 

base, 3) inner MRMS arm. ^ ° ut ! r ^ Ms a j r s m modeled based Q n physical data taken from 

connected by a sliding joint. Th J: SS c< / . . - modeied as a uniform beam with a 5m square 

Mah.et al. Automatic. 1989 The SSF keel is modeled as a un.ror ^ assumptions with 

ss: ^TiSs??5s-"s: 
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Performance Evaluation of PFL Control for SSF/MRMS 

Control Law s: 

• PFL SSF Attitude Decoupling 

• SSF Attitude Decoupling based on linearized equations of motion 

• Parameter Adaptive PFL SSF Attitude Decoupling fSSF keel stiffness estimated) 
Maneuvers: 

• 3 axis simultaneous attitude maneuver of 0.5 rad (Euler angles) 

• MR M C' 3 simultaneous 1 DOF joint motions 
(translation equivalent to 18m in 60 sec) 


Simu'ated performance evaluation of SSF attitude control with MRMS decoupling was 
per ormed for three control law variations including: nonlinear PFL, a linear decoupling 
control law. and MRAC modified nonlinear PFL control. The maneuvers considered were 
aggressive enough to differentiate the results. 


MRAC PFL Attitude Decoupling Control for SSF/MRMS 


MRAC comparator 


I reference model 
for attitude 
decoupling 



MRMS joint motion 
feedforward 


hi - body rates 

| - attitude coordinates 

u - MRMS joint & elastic coordinates 

0 - SSF keel stiffness 

1 ~ SSF attitude control torque 


(U, u) 


*(? * to) 
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Tradeoff Studies for PFL Attitude Control for SSF/MRMS 


1 . 


Nonlinear coupling due to keel flexure in a 
Nominal (precision modei-based) PFL for 
fixed-gain, decoupling control 


ttitude control: 

attitude maneuver compared with Linear. 


• MRMS feedforward accounted in both designs 

• nonlinear inertia variations due to keel flexure 
design 


limit domain of attraction in linear 


PFL robustness to S5F keel stiffness uncertainty 

. marginally stable slew response with 5% uncertainty (reduction) in keel stiffness 

. robustness limited by f active/passive) damping of keel flexure 

Robustness of PFL attitude control w/ MRAC correction for keel stiffness 
. improved slew response with 10% uncertainty (reduction) in keel stiffness 
. marginal slew response with 20% reduction in keel stiffness 

. guarantee of stability margin in keel flexure response with MRAC is difficult without 

-v, a ctnirfnrp rnntrol 


SSF/MRMS Scaling of Control Gains 

Control gains chosen for Decoupled Attitude Linear Dynamics 

System Eigenvalues 


Open Loop 


0 

0 

0 

0 

0 

0 

0 2 

0 2 

o 2 

-10.4212 ±1 0.5963i 
-10.8762 ±10.58761 
-0.2053 ± 3.3267i 
-0.2053 ± 3.32901 


Closed Loop 
Nominal (k) 


0 

0 

0 

0 

0 

0 

- 0.1763 ± 
- 0.1763 ± 
- 0.1364 ± 
- 0.1364 ± 
-0.2000 t 
-0.2000 ± 
- 0.2000 ± 


3.3205i 

3.3205i 

1 .65051 

1 .65051 
0.20401 
0.2040i 
0.2040i 


Closed Loop 
Detuned (k/8) 


0 

0 

0 

0 

0 

0 

-0.1763 ± 
-0.1763 t 
-0.1364 ± 
-0.1364 ± 
-0.0250 ± 
-0.0250 ± 
-0.0250 ± 


3.32051 
3.32051 
1 .65051 
1.65051 
0.09791 
0.0979i 
0.09791 


Unear controller effective for .01 rad slewing with Detuned Gains 




Midpoint Velocity Midpoint Displacement 


SSF/MRMS Attitude Slew with Precision 


PFL with MRMS 


Su. MRMS Decoupling 
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response for 3-body maneuver 


SSF/MRMS Attitude Slew with Precision PFL & MRMS Decoupling 
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SSF/MRMS PFL Attitude S 


lew with 5% Keel Stiffness Reduction 
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Nominal PFL slewing with 5 % reduction in keel stiffness - 

-SSF/MRMS response degradation is evident tor nomine. PFL attitude 

control 


SSF/MRMS Attitude Slew with MRAC PFL & MRMS Decoupling 
MRAC ^imation of keel stiffness re covers nominal s l ew perform ance^ 
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Mi'Uiuiiil Velocity Mklfuinl 


SSF/MRMS Keel Flexure with MRAC PFL & M RMS Decoupl 
PFL MRAC obtains stable response in keel flexure 
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Conclusions from Simulat ons 
Observati ons from SSF/MPMS Modeling: 

. Keel flexibility drastically alters nonlinear inertial coupling m attitude 
* MRMS motion exacerbates nonlinear inertial coupling 


maneuvers 


Control Law Comparsions: 


"jf small amplitude SSF attitude 


linear, fixed-gain control can achieve stabilization o r 
motions on a slow time scale 

□ stability robustness limitation is not evident from linear mode 
G domain of attraction is limited for fast time scale attitude regulat.o 


linear, fixed-gain, decoupling control demonstrates 
tions &l mode! uncertainty 


extreme sensitivity to MRMS mo- 


• PFL stability sensitive to keel stiffness parameters 
5 % reduction in keel stiffness results in oscillations w« 

of keel 


n magnitude on order of length 


• Adaptive PFL attitude maneuver control with extreme 
demonstrated tolerance to initial model uncertainty o 


MRMS multi-DOF motions 
f up to 10% reduction in keel 


stiffness 


The SSF/MRMS system model predicts a significant elastic deformation response o ^ 

kee! d^atmude slewing transients. This leads to large The res" 

although the beam model assumes small relative d.splacements m local body frames. . The resu t 
is significant nonlinear cross axis coupling during attitude man^ve^For 
attitudecontrol of the SSF/MRMS system the significance or the nonlinear inert, a uoup 9 

more significant than MRMS motion sensit,v,ty-e»en for d, astro. 

worst-case maneuvers considered in this study. 

The robustness and performance limits observed in the 

law appear to arise from a vanishingly small domain of attracts 

regulation. The tradeoff of attitude control gains vs. domain of attraction cannot 
predicted from linear models alone. 

PFL decoupling attitude control offers a direct design approach including feedfoiward o^ 
MRMS motions which compensates for predictable inertia changes due to keel e 
Won PFL atti ude control sensitivity to keel stiffness uncertainty ,s improved over linear 
decoupling control. Performance and bandwidth limits in PFL des.gn are traded off against 
stability of the decoupled dynamics (keel flexure dissipation). 

Parameter adaptive methods based on MRAC underlie practical application of nonlinear- 
decoupling control designs where model uncertainty is due to unmeasureable parame 

variation. 
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